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ABSTRACT 

This  paper  presents  experimental  results  for  the 
simultaneous  intercept  of  preassigned  targets  by  a 
team  of  mobile  robots.  The  robots  are  programmed 
to  mimic  the  dynamic  behavior  of  unmanned  air  ve¬ 
hicles  in  constant-altitude  flight.  In  proceeding  to 
their  targets,  robots  must  avoid  both  known  static 
threats  and  pop-up  threats.  An  overview  of  the  co¬ 
operative  control  strategy  followed  is  given,  as  well 
as  a  description  of  the  robot  hardware  and  software 
used.  Experimental  results  demonstrating  simulta¬ 
neous  intercept  of  targets  by  the  robot  team  are  pre¬ 
sented. 


1  INTRODUCTION 

Recent  military  conflicts  have  demonstrated  the 
strategic  value  of  unmanned  air  vehicles  (UAVs).  In 
the  past  UAVs  have  been  used  primarily  for  recon¬ 
naissance  and  surveillance  purposes.  More  recently, 
they  have  been  used  in  offensive  missions  as  a  bomb¬ 
ing  or  missile-launching  platform.  In  these  scenarios, 
UAVs  have  operated  independent  of  other  vehicles 
with  little  or  no  cooperation.  Although  they  have 
been  successful  as  single  agents,  UAVs  will  make 
greater  contributions  to  military  missions  as  their 
cooperative  capabilities  are  increased.  As  cooper¬ 
ative  control  strategies  for  teams  of  multiple  UAV 
agents  are  developed,  the  potential  impact  of  UAVs 
on  future  military  operations  will  certainly  broaden. 

Cooperative  control  of  multiple-UAV  teams  is  a 
subject  to  which  increasing  attention  has  been  given. 
Research  has  focused  primarily  on  three  areas:  UAV 
formation  flight,  cooperative  path  planning  (e.g., 
rendezvous),  and  resource  allocation  (e.g.,  target  as¬ 
signment).  The  motivation  for  formation  flight  of 
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UAVs  is  increased  stealth  and  fuel  economy.  In  close 
formations,  UAVs  are  coupled  dynamically  by  the 
aerodynamic  interactions  among  the  vehicles.  As 
such,  the  entire  formation  can  be  considered  as  a  sin¬ 
gle  large  system  for  which  a  control  strategy  must  be 
developed.  Strategies  for  formation  flight  of  UAVs 
are  developed  in  [1,  2,  3,  4]. 

Unlike  formation- flight  problems,  cooperative 
path  planning  and  resource  allocation  problems  usu¬ 
ally  involve  UAVs  that  are  physically  independent  of 
one  another,  although  they  may  be  coupled  dynam¬ 
ically  by  their  cooperative  control  algorithms.  Sev¬ 
eral  important  UAV  cooperative  control  problems 
can  be  formulated  as  resource  allocation  problems. 
This  includes  target  assignment  problems  [5,  6],  co¬ 
operative  classification  problems  [7],  and  coopera¬ 
tive  search  problems  [8].  The  majority  of  coopera¬ 
tive  path  planning  problems  considered  in  the  liter¬ 
ature  involve  timing  or  sequencing  of  UAVs  for  ar¬ 
rival  at  targets  or  other  specified  locations,  such  as 
the  cooperative  intercept  problem  considered  here. 
A  cooperative  control  strategy  for  UAV  rendezvous 
was  presented  in  [9].  Cooperative  path  planning  is 
also  employed  in  cooperative  search  and  cooperative 
classification  problems  [10]. 

Up  to  the  present  time,  UAV  cooperative  control 
research  has  consisted  of  simulation  studies.  This 
paper  presents  initial  results  in  cooperative  path 
planning  for  a  team  of  wheeled  robots.  These  robots 
are  programmed  to  simulate,  in  hardware,  UAVs  in 
constant-altitude  flight.  This  work  presents  a  decen¬ 
tralized  cooperative  control  strategy  and  examines 
its  suitability  for  real-time  implementation. 

The  specific  problem  treated  in  this  paper  is 
similar  to  that  presented  in  an  earlier  simulation 
study  [9].  As  depicted  in  Figure  1,  three  robots  must 
navigate  through  a  field  of  known  threats  (depicted 
by  red  dots)  to  arrive  at  preassigned  targets  (de¬ 
picted  by  stars).  The  cooperation  objective  is  for 
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the  robots  to  arrive  at  their  targets  simultaneously 
to  maximize  the  element  of  surprise.  The  robots 
must  be  able  to  respond  to  unknown  pop-up  threats 
as  well. 


Figure  1:  Cooperative  intercept  problem. 


2  COOPERATIVE  CONTROL 
METHOD 

The  cooperative  control  strategy  followed  in  this 
work  is  similar  to  the  approach  first  presented 
in  [9,  11].  For  completeness,  a  brief  review  of  the 
approach  is  presented  here.  The  team  objective  is  to 
minimize  the  collective  threat  exposure  of  the  team 
over  the  mission.  The  cooperation  objective  is  si¬ 
multaneous  intercept  of  the  assigned  targets.  Given 
the  battle  scenario  depicted  in  Figure  1,  each  robot 
has  numerous  possible  trajectories  that  it  can  take 
to  its  assigned  target.  Candidate  trajectories  for 
the  robots  are  derived  from  a  search  of  a  Voronoi 
graph  that  is  constructed  from  the  known  threat 
locations  [9].  The  ten  safest  paths  for  each  robot 
are  determined  using  a  k- best  paths  search  [12]  of 
the  Voronoi  graph.  The  trajectories  for  each  robot 
are  parameterized  by  a  sequence  of  waypoints  and  a 
constant  velocity.  These  parameters  are  called  agent 
decision  variables.  In  general,  decision  variables  for 
the  ith agent,  are  those  variables  that  can  be  freely 
determined  by  the  agent  that  govern  its  behavior. 


To  arrive  at  their  targets  simultaneously,  the 
robots  must  have  the  same  time-over-target  (TOT). 
In  this  problem,  TOT  is  defined  as  the  coordina¬ 
tion  variable,  6.  Notice  that  for  each  robot,  TOT 
is  a  function  of  the  trajectory  parameters,  i.e.,  6i  = 

m)- 

The  threat  exposure  of  each  robot  is  also  a  func¬ 
tion  of  the  trajectory  parameters.  In  this  prob¬ 
lem,  the  threat  exposure  of  each  robot  is  called  the 
agent  influence,  <fi .  The  influence  of  the  ithagent 
on  the  team  objective  is  described  by  this  function: 
4>i  =  hi(£i).  For  this  problem,  the  team  objective 
can  be  written  as 

3 

min  JT  = 

(i  i=  l 

while  achieving  the  cooperation  objective  (simulta¬ 
neous  intercept):  0i(fi)  =  02fe)  =  #3 (£3)-  This 
centralized  formulation  of  the  cooperation  problem 
is  cumbersome  and  inefficient.  It  requires  the  si¬ 
multaneous  determination  of  all  trajectory  parame¬ 
ters  for  all  robots.  This  requires  trajectory  planning 
for  all  robots  to  be  centralized  and  communication 
of  potentially  large  amounts  of  information  (robot 
state,  threats,  trajectory  parameters). 

A  more  efficient,  decentralized  approach  is  en¬ 
abled  through  the  definition  of  a  coordination  func¬ 
tion,  0.  For  this  problem,  the  coordination  function 
describes  the  relationship  between  threat  exposure 
and  TOT:  fa  =  gi(6i).  For  the  candidate  paths  con¬ 
sidered,  TOT  and  threat  exposure  can  be  readily 
determined  from  path  length,  velocity,  and  threat 
location  information.  From  this  information,  coor¬ 
dination  functions  for  each  of  the  robots  can  be  com¬ 
puted.  With  coordination  functions  for  each  agent 
defined,  the  cooperative  control  problem  can  be  re¬ 
formulated  as 


0*  =  arg  min 
eeoT 


where  ©t  is  the  team-feasible  range  of  TOT  values. 
Once  the  team-optimal  TOT  has  been  determined, 
trajectories  for  each  of  the  robots  can  be  found  by 
inverting  the  coordination-variable  relationship 


&  =  rl(o*)- 


This  decentralized  strategy  is  depicted  graphically 
in  Figure  2. 
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Figure  2:  Cooperative  path  planning  algorithm. 


3  TRAJECTORY  GENERATION 

The  output  of  the  cooperative  path  planner,  is 
a  set  of  waypoints  and  the  desired  velocity  for  each 
robot.  Given  this  information,  a  trajectory  gener¬ 
ator  is  needed  to  generate  time-parameterized  tra¬ 
jectories  that  are  feasible  within  the  dynamic  con¬ 
straints  of  the  vehicle.  In  this  work,  we  impose  UAV 
dynamic  constraints  on  the  robots.  The  underlying 
idea  for  the  trajectory  generator  is  to  use  a  nonlin¬ 
ear  filter  that  has  a  mathematical  structure  similar 
to  the  kinematics  of  a  UAV  to  generate  trajecto¬ 
ries  that  smooth  through  the  waypoints  in  real  time 
while  the  vehicle  traverses  the  trajectory.  For  a  UAV 
with  heading- hold  and  altitude- hold  autopilots,  fly¬ 
ing  at  constant  altitude  and  velocity,  the  governing 
kinematics  are  given  by 

Xf  =  vfcos  ip? 

Y?  =  V?  sinVf 

\lpi  |  ^  ^max 

V?  =  0 

hi  =  0. 

Based  on  the  desired  velocity  and  the  heading  rate 
constraint,  a  minimum  turning  radius  for  the  vehicle 
can  be  determined: 


Note  that  as  the  desired  velocity  increases,  then  the 
minimum  turning  radius  increases.  Conversely,  as 
the  heading  rate  capability  of  the  vehicle  increases, 
the  minimum  turning  radius  decreases. 

Consider  the  problem  of  turning  from  one  way- 
point  path  segment  onto  another  in  minimum  time 
at  constant  velocity.  If  the  trajectory  is  not  con¬ 
strained  to  pass  through  the  waypoint  connecting 


the  two  segments,  then  the  time-optimal  trajectory 
connecting  the  segments  is  indicated  by  the  red  line 
of  Figure  3.  If  the  trajectory  is  constrained  to  pass 
through  the  intermediate  waypoint,  then  the  time- 
optimal  trajectory  between  the  segments  is  indicated 
by  the  blue  line. 


Figure  3:  Time-optimal  transitions  between  way- 
point  path  segments. 


One  of  the  disadvantages  of  both  minimum-time 
transitions  and  transitions  constrained  to  go  through 
the  waypoint  is  that  the  trajectories  generated  will 
have  different  path  lengths  than  the  original  Voronoi 
path.  Since  the  Voronoi  path  is  used  for  determining 
intercept  times,  it  is  desirable  that  the  smoothed  tra¬ 
jectory  have  the  same  length  as  the  original  Voronoi 
path. 


Figure  4:  Length-matching  transitions  between  way- 
point  path  segments. 


From  Figure  3,  it  is  clear  that  the  path  length 
of  the  minimum-time  trajectory  is  shorter  than  the 
path  length  of  the  Voronoi  path,  while  the  path 
length  of  the  constrained  trajectory  is  longer  than 
the  Voronoi  path.  As  Figure  4  shows,  by  position¬ 
ing  the  transition  circle  between  the  inscribed  circle 
and  the  circle  that  intersects  the  waypoint,  a  tran¬ 
sitioning  trajectory  can  be  determined  that  has  the 
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same  length  of  the  original  Voronoi  path.  Details  of 
this  trajectory  generation  strategy  and  algorithms 
for  implementing  it  can  be  found  in  [5,  13].  The 
end  product  of  the  trajectory  generator  is  a  smooth 
trajectory  for  the  robots  to  follow  that  is 

calculated  in  real  time  as  the  they  move  between 
waypoints. 


4  EXPERIMENTAL  APPARATUS 


Experiments  were  conducted  in  the  Multi- AGent 
Intelligent  Coordinated  Control  (MAGICC)  Labora¬ 
tory  at  Brigham  Young  University.  The  lab  facility 
consists  of  five  two- wheeled,  mobile  robots  shown  in 
Figure  5.  Each  robot  is  equipped  with  a  Pentium 
grade  PC  104  processor  and  is  connected  via  a  wire¬ 
less  LAN  to  the  other  robots  and  host  PC  computers 
in  the  lab.  The  host  and  robot  computers  use  the 
Linux  operating  system.  Given  the  relatively  slow 
dynamics  of  the  robots,  Linux  is  adequate  to  provide 
the  soft  realtime  capabilities  needed  for  controlling 
the  robots.  Robot  positions  are  determined  using 
a  vision  system  with  an  overhead  camera.  Encoder 
measurements  from  the  robot  drive  wheels  are  also 
utilized  to  reduce  the  effects  of  noise  in  the  vision 
data.  The  robot  field  is  5  m  square. 


Figure  5:  BYU  MAGICC  Lab  robots. 


To  emulate  UAVs,  the  robot  velocities  were  con¬ 
strained  to  be  between  0.0096  and  0.0117  m/sec 
for  the  results  reported  here.  These  slow  veloci¬ 
ties  maintain  the  time  scaling  between  the  robot 
workspace  and  a  typical  UAV  battle  area.  These 
robot  velocities  correspond  to  a  UAV  flying  between 
0.122  and  0.149  km/sec  (270  to  330  mph)  in  a  63  km 
by  63  km  battle  area.  The  heading  rate  of  the  robots 
was  limited  to  be  less  than  10  deg/sec. 


5  CONTROL  IMPLEMENTATION 

The  cooperative  control  algorithms  described  pre¬ 
viously  and  low-level  tracking  controllers  required 
for  simultaneous  target  intercept  were  implemented 
on  the  MAGICC  Lab  host  and  target  computers. 
Each  computer  runs  Matlab/Simulink  under  the 
Linux  operating  system.  Each  controller  utilizes  the 
MAGICC  Mobile  Robot  Toolbox  (MMRT)  [14]  that 
runs  under  Simulink.  MMRT  provides  software  tools 
(e.g.,  device  drivers,  timing  routines,  TCP/IP  sock¬ 
ets,  controller  software)  for  rapid  implementation  of 
mobile  robot  control  algorithms.  Figure  6  shows 
how  the  cooperative  control  architecture  was  imple¬ 
mented. 


Robot  target 

PCI 04  Pentium 

Robot  target 

PCI  04  Pentium 

Robot  target 

PCI  04  Pentium 

Linux 

Linux 

Linux 

Matlab/Simulink 

Matlab/Simulink 

Matlab/Simulink 

MMRT 

MMRT 

MMRT 

Tracking 

Tracking 

Tracking 

controller 

controller 

controller 

Figure  6:  Control  architecture  implementation. 

Control  computations  are  distributed  among  the 
host  and  robot  computers.  Because  position  infor¬ 
mation  for  the  robots,  targets,  and  threats  comes 
from  a  global  vision  system  to  the  host  computer, 
most  of  the  cooperative  control  computations  are 
carried  out  on  the  host.  In  future  implementa¬ 
tions,  position  information  will  be  passed  down  to 
the  robots  and  control  computations  will  be  carried 
out  on  the  robots  directly.  Currently,  trajectory  in¬ 
formation  and  coordination  functions  are  computed 
for  each  robot  independently  on  the  host  computer. 
Coordination  function  information  is  utilized  to  de¬ 
termine  the  team-optimal  trajectory  for  each  robot. 
Desired  trajectory  information  is  passed  down  to 
each  robot.  On  each  robot,  a  tracking  controller  is 
implemented  to  follow  the  desired  trajectory.  Actual 
robot  state  information  is  passed  from  the  robot  up 
to  the  host.  All  control  computations  on  the  robots 
and  host  are  carried  out  at  10  Hz. 
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6  RESULTS  AND  DISCUSSION 

Three  MAGIC C  robots  were  programmed  to  exe¬ 
cute  the  simultaneous  intercept  task  described  ear¬ 
lier.  Figures  7  through  10  show  the  trajectories 
traced  out  by  each  robot.  The  threats  to  be  avoided 
are  indicated  by  small  red  dots.  Pop-up  threats 
are  marked  by  cyan-colored  dots.  The  targets  are 
marked  by  stars.  The  thin  lines  indicate  the  de¬ 
sired  waypoint  paths  for  each  robot,  while  the  ac¬ 
tual  paths  traversed  by  the  robots  are  marked  by 
bold  lines.  Figure  7  shows  the  initial  trajectories 
of  the  robots  proceeding  the  detection  of  the  first 
pop-up  threat  by  robot  2.  Referring  to  the  desired 
waypoint  paths,  it  can  be  seen  that  robot  1  takes  a 
fairly  direct  path  through  the  threats  to  its  target. 
In  order  to  ensure  simultaneous  TOT,  robot  2  takes 
an  indirect  route  that  is  safe,  but  longer  in  length 
than  other  more  direct  options.  The  initial  jog  in  the 
path  of  robot  3  accomplishes  this  same  objective. 


Figure  7:  Robot  trajectories  -  first  pop-up. 


Upon  detecting  the  pop-up  threat,  the  cooperative 
path  planning  algorithm  is  executed  to  determine 
new  waypoint  paths  that  avoid  both  the  existing  and 
newly  discovered  threats.  Figure  8  shows  the  paths 
planned  in  response  to  the  first  pop-up  threat.  The 
paths  for  robots  1  and  3  are  unchanged,  while  the 
path  for  robot  2  avoids  the  pop-up  threat.  Figure  8 
also  shows  the  detection  of  a  second  pop-up  threat 
by  robot  1.  Waypoint  paths  avoiding  this  second 
pop-up  threat  are  shown  in  Figure  9.  A  third  pop¬ 


Figure  8:  Robot  trajectories  -  second  pop-up. 


up  threat,  detected  by  robot  3,  is  also  shown  in  Fig¬ 
ure  9.  Final  paths  to  each  of  the  targets  are  shown  in 
Figure  10.  In  avoiding  the  third  pop-up  threat,  the 
path  of  robot  3  is  lengthened  significantly.  To  enable 
simultaneous  TOT,  the  path  of  robot  1  is  lengthened 
slightly  with  the  inclusion  of  an  additional  waypoint 
near  the  target.  Figure  10  clearly  shows  the  robots 


Figure  9:  Robot  trajectories  -  third  pop-up. 
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intercepting  their  targets  simultaneously. 


Figure  10:  Robot  trajectories  -  over  targets. 


Figure  11:  Robot  range  to  target. 


The  effects  of  the  computational  latency  involved 
in  the  cooperative  path  planning  can  be  seen  in  Fig¬ 
ure  10.  Upon  detection  of  a  pop-up  threat,  the  co¬ 
operative  path  planning  algorithm  is  executed.  In 
its  present  implementation,  the  algorithm  takes  ap¬ 
proximately  5  to  10  seconds  to  run.  During  the  ex¬ 
ecution  of  the  path  planning  algorithm,  the  robots 
continue  to  move  according  to  the  last  motor  com¬ 
mands  they  received.  Position  information  is  not  ac¬ 


quired  during  the  path  planning  phase.  The  white 
gaps  in  the  robot  trajectories  of  Figure  10  indicate 
the  motion  of  the  robots  during  the  execution  of  the 
cooperative  path  planning  algorithm.  The  faster  the 
nominal  speed  of  the  robots,  the  greater  the  degra¬ 
dation  of  the  system  performance  due  to  compu¬ 
tational  latency.  Experiments  performed  at  three 
times  the  speed  of  those  presented  here  showed  sig¬ 
nificant  degradation  that  resulted  in  threats  being 
hit  and  large  differences  in  TOT.  If  the  spacing  of  the 
threats  divided  by  the  speed  of  the  robots  is  compa¬ 
rable  to  the  computational  latency,  then  latency  will 
negatively  affect  the  performance  of  the  system.  It 
is  anticipated  that  this  latency  could  be  reduced  sig¬ 
nificantly  by  more  effectively  distributing  the  com¬ 
putation  among  the  robots,  improving  the  coding  of 
the  algorithms,  and  by  porting  the  algorithms  to  a 
compiled  programming  language.  Furthermore,  ef¬ 
fective  strategies  for  mitigating  the  degrading  effects 
of  computational  latency  can  be  developed. 

Figure  11  demonstrates  that  the  robots  inter¬ 
cepted  their  respective  targets  at  the  same  time. 
The  smooth  bumps  in  the  range  curve  for  robot  2  at 
110  seconds  and  robot  3  at  130  seconds  and  320  sec¬ 
onds  indicate  that  they  move  away  from  their  targets 
momentarily  to  enable  the  team  cooperation  objec¬ 
tive:  simultaneous  intercept.  The  convergence  of  the 
ranges  to  zero  near  390  seconds  demonstrates  that 
this  objective  is  achieved.  The  abrupt  drops  in  range 
that  occur  at  145,  211,  and  231  seconds  indicate  the 
change  in  range  that  occurred  during  the  compu¬ 
tation  of  cooperative  path  planning  algorithm.  The 
time  variable  does  not  indicate  true  real  time  in  that 
the  time  clock  did  not  advance  while  the  cooperative 
path  planner  was  executing. 


7  CONCLUSIONS 


This  paper  presents  results  for  experiments  in 
multi-robot  cooperative  interception  of  preassigned 
targets.  Results  indicate  that  the  proposed  coopera¬ 
tive  path  planning  strategy  is  a  promising  approach 
for  cooperative  timing  problems  requiring  implemen¬ 
tation  in  real-time.  Results  also  show  that  the 
method  can  readily  accommodate  pop-up  threats 
provided  that  the  effects  of  computational  latency 
are  small  relative  to  the  specified  robot  velocities 
and  distances  between  threats. 
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